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Appendix C 


The appendix contains the graphical results of the Monte Carlo 
analyses of the Double Filter. In each test, the filter states are 
initialized to the initial true values. The tuning parameters used 


in the filter are (Note: The state vector is 
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The results of the trajectories tested are arranged as follows: 


Figure 


C-1 to C-18 
C-19 to C-36 


C-37 to C-54 


C-55 to C-72 


Double 


K 


K 


K 


Double 


K 


Sub ject 


Filter with four measurements 
Set One 

Set Four, Three Dimensional 
Set Four, Two Dimensional 
Filter with two measurements 


Set Four 


—— ——— - 


{4.Y¥) PLANE 


MEAN ERROR 
X-VELOCITY 
OOUBLE FILTER 


TIME (SEC 


( 


00'00! 00°09 00'0 00'o0S-—- 
J35S/i334 


00°OST 


Fig. C-1 X-VELOC{(TY OOGUBLE FILTER 


3 


FILTER 


=TRUE 
>= 
(X.Y) PLANE 


X-VELGCITY 


SIGMAS: X 


ao 
+e 
nO 
uJ 
op) 
ve tad 
ws 
Se 
i=) 
~ 
we) 
(pe) 
Ss) 
| 
Oo 
; — 
- OO°CE O0"rS OO'SE 00's ° o0’o 
J3aS/1ad3 
( 
Figs C-2 X-VELOCITY SIGMAS OGUBLE FILTER 
4 
| 
| Topi tela oe ob Bie Laks 


NNd 
00°2z oo-6t 00-9 oo-Et ODO 


a 


SNS1d (A°X) 

y3aliid a ansa 

ALID013A-X 
SONUIMBA 


00°0™ 


00°0S 


JINUIYGA 


00'OGT 


00'°OST 
01x 


nr 
Co 
=) 
oOo 
i=) 


ve 


VARIANCE CONVERGENCE 


Fig. C-3 


ee 


LJ33) awit 
S'S DIS SZ "+ DYE SS°Z OL't _ $3"0 00° 


g0"0-- 


fe al 
| ro 
ad 3 
' oO — 
| ap jt 
} WwW 
= Iz 
ja = 
= 

Sa a 

OQ 

7 rs 


o0*0- 
ANGLE MEASUREMENT 


SNS1d (AX) 
y31TI4 378Nn00 
AN3SWSYNSH3SH SION 
YOY NYS 


Fig. c-4 


= 
r 
tu 
x 
lJ 
a 
=a 
172) 
xc 
ld 
x 
a 
= 
« 


FILTER 


ae 
(X.Y) PLANE 


SIGMAS: X=TRUE 


91 '0 


80'0 


SNUITOUY 


Fig. C-5 ANGLE MEASUREMENT SIGMAS 


DOUBLE FILTER 


oc 
Wy WW 
< - = 
oO is 4 
( uy ee LJ 
= © t& & 
Ww =z 
Qu- 
= Ss of > 
jee “OM os 
ud 2D x 
xr Oo ~ 
a 


Oo 
Oo 
00'+Z- O0'ye€- -O00'VR— 
1334 


Fig. C-6 RANGE OGUBLE FILTER 


8 


SNO1d (A‘X) 
Y3lII s=< 
SNYL=X *SydIS 
SONBY 


OGUBLE FILTER 


RANGE SIGMAS 


Fig. C-7 


© 


(J9S? gsuii 
S6°S Ors S29 OE Ss ‘2 DL*1 $20 00°0 
es See ee i 


00°ST 


co . 
oO e 
° = 
uw 
7 WW 
sad 
A mone om 18 
nj VAS O 4 oO 
ate oO 

ep) 
bi, = 
O x 
oe) oO 
3 lu 

Len) 

= S 
cx 
[ead 
@ 
BNYId (A*X) ° 
ual114 37enea a 
3iby JONYY = 


YOUNs NYS 


10 


(33S) S3WIl 
Ove ss°a 
licaiiecipcmajanensiill etesitiateasiaaiaate ace 


SNB1d (A‘X) 
ysl s=< 
SNY1=X 2SBWdISs 
318Y SONBY 


— 
a™M 
SB yy. 
on 
(Sp) 
mM 
Oo 


00°9 


Fig. C-9 


RANGE RATE SICMNAS OGUBLE FILTER 


11 


SNY1d (A*X) 
¥31714 31ENn90 
NOI18Y313998 1b 
YOUU NBS 


“Y 


(95S) SWIl 


Ove 


SS°2 


OL* 


LAT ACCELERATIGN OCUBLE FILTER 


Fig. C-10 


12 


sss OT's 


SNB1d (ASX) 
y3L 1 s=< 


SNYI=X FSBUSIS 
JSNYUIZYA DSB 187 


S2°9% 


(93S) 3WIl 
Ove Ss°Z 


OL° 


09't 08°0 
$.9 


OV '2 


02'°€ 


DOUBLE FILTER 


Fig. C-11 LAT ACCELERATION SIGNAS 


13 


— 


NAY 
o0-Ot 


00°22 oo°-6t Oo°St oo-et 


WwW 
OU 
= 
WW 
ra) 
ow 
> 
7 2 
ow) =) 
jn - o n - oO az) 
S 7 ™ - S 2 om 

cd ies = 
CO on 
m oc 
a fom 
rs > 

no 

oO 
nr 
Boel 
SNH1d (A‘X) aS 
¥31714 3909N00 i 
NOJI8Y37399¥ 1b7 = 


SINYINYA 


14 


ee 


(33S) SWIL 
O7'€ Ss°Z 


0, 
o 
» 
i=) 


| ! 
| . al 
Ph 
om 
9) 
es) 
=) 
en 38 
Om 
| > 
@ 
= 
— 
st 
eh 
ro 
om 
Oo 
>~ 
oO 


SNSId (A‘X) 
¥31II4 31enea 

ANYISNODD AUN-OUd 
¥OUUS NYS 


PRO-NAV CONSTANT OGUBLE FILTER 


Fig. 0-13 


15 


(35S) SWIL 
Dv“ SS°Z OL*t $8 "0 00°J 


Or'd 


08'0 
JONLINOBW 


— 
O2't 


SNb1d (A‘Z) 
val 4=< 

BNYLl=X iSBudIs 
AINHISNOD AYN-OUd 


TANT SIGYAS OGUBLE FILTER 


NAV CONS 


PRO- 


C-14 


Fig. 


16 


MERN ERROR 
MASS/SURF 


OOUBLE FILTER 
(X.Y) PLANE 


Y 


Y 
ij 


00'S 00'0 00°S- O00°OI-. o00'ST— 
L47145/S9N1S 


Fig. C-15 MASS/SURF OOUBLE FILTER 


17 


s6°s Ot° 


SNB1d (A°X) 
Y31L TI s=< 


SNYI=X 2SBWSIS 
JYNS/SSEU 


SZ 


“Y 


(J35) 
Ove 


JWIL 
SS °Z 


OL° 


00'+ 00°S - 
L4/14/7S9N1S 


00°S 


00°8 


OGUBLE FILTER 


MASS/SURF SIGMAS 


Fig. C-16 


18 


(JaS} anil 
Ors SS°Z 
Sr Ce Se ee eee 


i=) 
i=) 

' 
i=) 


=) 
wD 
>) 


02°0- 


01 *0- 
SONOISS 


00°0 


SNU1d (AX 


y3llis ened 
YIL3Keysd NL 
YOUYS NYS! 


‘DOUBLE FILTER 


TAU PARANETER 


Fig. C-17 


19 


SNUNd (AX) 
YALTI s=< 
SNYl=X =SBWdIS 
Y3BLAWEYed NBL 


iS p) 
om 
an, 

er) 
. 

oO 

(Sp) 


TAU PARAMETER SIGMAS OCUBLE FILTER 


Fig. C-18 


20 


iS Ts) 


tw 
z 
a 
mi 
a. 
7 
> 
Pad 


MEAN ERROR 


tc 
Ww 
= 
a 
— 
w 
Ww 
J 
ra) 
2 
ra) 
ra) 


5.10 


4.25 


3.40 


2,55 
TIME (SEC) 


i=) 


nae eS ee ae eT 
00’06t  O00'OrI 00°06 O0°0r  00°OT- 
JI9/is3a3 


Fig. C-19 X-VELOCLTY OGUBLE FILTER 
21 


= 


>=FILTER 
(X.Y) PLANE 


X-VELOCITY 
SIGMAS: X=TRUE 


| 


a eee Eee ESE 
- 00°ZE 00" Oo"9t 00'S 00°0 
J33/ i343 


Fig. C-20 X-VELOC(ITY SIGMAS OGUBLE FILTER 
22 


“NAY 
00°22 oo0"st oo*9t OD"Et ODO 
Ln serarennenssiocaeemninienelieimesiesicsseeie it inisiveriisssntne niacin acai cance 


a a VA 


\ ~ ww 
Cet ie 
Coda 

Ww 
dies oO 
~ Pa 
may > 
a2 = A 
Boers o 
ee oa 
am tJ 
Q oO 
= 
red 
% ar 
en = 
a 

CS 

o 

oo 

OQ 

fon) 

QoQ 
’ Q 
SNY1d (A°X) ml 
1 Y3BIIIS 378Nne0 
ALIBONZA~X rs 


SINBIYYA 


23 


BNBTe (A'X) 
¥aLII4 a1sNoa 
ANSUSUNSHBW JTONY 

| yous NYS 


Le as eh tale! 


I 


(JaS) gwWwil 
DYE Ss°Z DLT seo 00°0 


00'0 


| Te ee en ae Ga 
0 v0'O 
SNUTOBY 


ANCLE MEASUREMENT OOUBLE FILTER 


Fig ° C -22 


24 


(95S) SWIl 
Dr's Ss°Z 


R9'0 


9 
SNUTObY 


Jus 


SNB1d (AX) 

wali s=< 
SNYL=X FSBWDIS 

AN3SHSYUNSESH JIONY 


OOUBLE FILTER 


Fig. C-23 ANCIE MEASUREMENT SIGMAS 


25 


ee me 


el 


4 
© 
tc 
tS 
tJ 
= 
jas 
tu 
rc 


ag 
WJ 
ie 
a 
= 
ca 
=z 
a WwW 
a 
a 
— 
oO 
(=) 


(X.Y) PLANE 


- 


Fig. 0-24 


00°02 


a 
= 


— <a 
00°0 00'0¢- 00’°OF- 
L323 


RANGE OGUBLE FILTER 
26 


5.10 $.95 


4.25 


1.70 


0.85 


Oo 
oO 


‘00'°09-° 


(938) suit 
S'S OL's S2°4 O's SS °Z DLT S8°o 000 


SNB1d (A‘X) 
yal s=< 

SNYL=X 2SyudIS 
JONBY 


Fig. C-25 


RANCE SIGMAS OOUBLE FILTER 


27 


oo 


(33S) 3WIl 
Sé"s Ot's SZ*+ Oy Ss* Dut $8 ‘0 00° 


00 


4 
00*1- 
OOUBLE FILTER 


00°L 
Jaefigaa 


28 


OO°St 
RANGE RATE 


00°E% 


- 


SNB1d (A‘X) 
¥31713 378Nne0 

31Y¥Y 3SONdY 
YOYN3S NYSY 


———————— 


———— a a i ee ie rr a — ae 


00" 


00°% 


_ 
—_—— 
ee 
OO'+r 
335S/135354 


RANGE RATE SIGMAS OOUBLE FILTER 
29 


=| 

ad 

“= 
00°9 


00°8 


SNngnd 
YBLNI s=< 

ANYI=EX *SsHoIsS 
318y 


Fig. C-27 


(35S) 3WIL 
D+ “e SS°3 
De cnindieetahikahennlipiasaneaaideienttshcaeanine do 


SNY1d (ASX) 
¥v31NI3 378Nnsa 
NOILEY3SIZISN 187 
YOYY3S NB3W 


LAT ACCELERATIGN OOUBLE FILTER 


Fig. C-28 


30 


osc 


(33S) 3WIl 
SZ" Ove Ss ‘*Z 


OOUBLE FILTER 


31 


SNU1d [A‘X) 
yal s=< 

SNYl=X =Sywais 
SINGIMBA IBV 181 


Fig. C-29 LAT ACCELERATION SIGMAS 


NN 
00°33 oo-st oo°st oo-Et oo°Or ea a 00°? 00° 
| s 


W 
U 
z= 
W 
oO 
~ 
WwW 
> 
> |z2 
_ oO 
- #0 az) 
Re tw 
D> oO 
a, = 
O oa 
™ ts 
ad > 
~~ 
oO 
A 
BNUTd (A‘X) & 
W314 378nd0 ° 
NOI1BY373998 1B = 


SINE ILYBA 


32 


— 


OCUBLE FILTER 


(X.Y) PLANE 


PRO-NAV CONSTR 


os't 04°0 01°0- 06°0- dL*I- 
JONLINOYW YONYS ; 


Fig. C-31 PRO-NAV CONSTANT OOUBLE FILTER — 
33 


«< 

Land WJ : 
= We 
Qo J ty 
—- em SZ 
Mth 
roa | i | | 
OR A A 
YU 

> a ~ 
Ze x 
16 & 
€) + 

a Ww 

oO. 


- og't 02° 08'0 DF" 00'd 
JONLINDUW 


Fig. C-32 PRO-NAVY CONSTANT SICNAS OGUBLE FILTER 
Sar 


(238) 
Ove 


SWIL 


SS°S 


| SNU1d (A*X) 


¥y3il1s 378Nno00 
JYNS/SSBU 


| YOLYS NYSU 


00°? 


00°6 


L4/1L4/S9N1S 


OGUBLE FILTER 


MASS/ SURF 


Fig. C-33 


35 


FiLTER 
$.35 


tJ 
= 
tc 
bes 


SIGMAS: X 
> 
(X.¥} PLANE 
Sa a a a a i) en a a a at (arg 
2.55 3.40 4.25 5.10 
TIME tSeC J 


ae; 0D 
» oO 
Lo 

oO 

a a cp —— o 

. 00°89 00°9 00"F 00°2 00 °0° 


l4/L47sanis 


Fig. C-34 MBSS/SURF SICMAS OGUBLE FILTER 


36 


tc tc 
Ww w 
OS ee bey 
Ow 91 
es Sey 
eee ec 
i ~ tr woo 
a SS ae 
= ao — 
ee 
—_ 
, ee" ¥0°O0- 80°*0- ot°0- 
SONOISS 
Fig. C-35 TAU PARANETER QGUBLE FILTER 


37 


TRUE 


(X.Y) PLANE 


tc 
uJ 
~ 
td 
tH 
a 
«cc 
a 
oH 
= 
[ox 
b~ 


SIGMRS: X 


91°0 20°0 80'0 r0'0 
. SONOIAS 
Fig. 0-36 TAU PARAMETER SIGMAS OGUBLE FILTER 


38 


NEAN ERROR 

X-VELCCITY 
OOUSLE FILTER 

(X.Y) PLANE 


_00°0%Z 00°09t 00°08 00'0 
I35S/1334 
| Fig. 0-37 X-VELOCLTY OGUBLE FILTER 
39 


3.40 


— 
O 
uJ 
vp) 
lu 
2. 
— 
—_ 


2.55 


SWIL 
Ss*Z 64° Se"0 00°0 


(9345) 
OF'E 


OO0*OT 


Jasfiaaa 
X-VELOCLTY SIGMAS OGUBLE FILTER 


OO°SI 


00°08 


SNB1d (A‘X) 
¥31I1 s=< 


BNY¥L=X tSyOIs 
AL13D07134-X 


Fig. C-38 


40 


NAY 
OOO 


00°22 oo"6t o0°st oo°Eet 


SNBIS (A°X) 
¥y31714 3739Nn00 
ALIDOTBA-X 
JONYIEYA 


00°Oe! 00°08 00*0+ 


-00°091 


JINUIYVA 


,O1* 


VARIANCE CONVERGENCE 


44 


Fig. C-39 


(33S) 3WIl 


sé°S ot’s S2° Ors Ss°aS] OL*T s8°o 00°0, 
CS 
\ So 
. > 
ff ¥ 
om * + ao 
—J - 5 
= w 
2 13 
at S 
Fl oO 
on - 
> 


42 


ANCLE MEASUREMENT 


BNU1d [A*X) 
¥317143 378n00 


AN3H3ZUNSU3ZN ITONY 
¥YOUYS NY3BH 


Fig. C-40 


FILTER 


>= 
(X.Y) PLANE 


ANGLE NEASURENENT 
SIGNAS: X=TRUE 


Oo 
+“ 
, CO) 
Mo 
WY 
yy Ut 
Te ag 
_— 
baal 


0.85 


is) 
oO 

. 
i=) 


—— 
oe’ ZA 91°O 80'0 9°0 
- -01* SNUIOUY 


Fig. C-41 ANGLE MEASUREMENT S(GMAS OOUBLE FILTER 


43 


SNB1d (A°X) 


yalIIs 378N00 - 


SONUY 
¥OvYZ NSU 


(3335) 
Ove 


SWI 
Ss°Z 


RANGE OGUBLE FILTER 


Fig. C-42 


| (33S) S3WIl 
| §6°S ot’s SZ'¢ Ors $o°2 OLLI 
| | Se ee ee eee 


OOUBLE FILTER 


RANGE SLGMAS 


BNYTd (A°X) 
Yals=< 
| SN¥1I=X FSyYHdIS 


| SON8Y 


Fig. 0-43 


cc 
uJ 
j—_ 
=J 
— 
wW 
uw 
ad 
ee) 
— 
© 
oS 


00'S 
J38/1332 


RANGE RATE 


SNY1d (A‘X) 
¥2iTls 37899 
21bY SONY 
YOUR Nyy 


ERciatieni 


(93S) SWIl 
S6°S ors S2°+ Ov'e SS °2 OL't S30 00° 


a 
> 
| 
[~=S 
== 
— 
ae 
OO’? 
93S/135354 


=< 
— 
—. 
00'S 


BNE (A'X) 

Y311N 4s=< 
SNY1=X eSsUaIS 

3iby 3JON¢y 


OGUBLE FILTER 


RANGE RATE SICNAS 


47 


=z 

oO «= 

~ td Wd 
em he & 2 
oa JF & 
ee = 
eSwtk« & 
as of 

Wwe 
a: Gh aa om 
co @ -« 
waa x 
z= oOo — 

- O 

Q 

a 


3.40 
TINE (SEC) 


2.55 


Fig. C-46 LAT ACCELERATION OOUBLE FILTER 


48 


OOUBLE FILTER 


SNB1d (A°X) 
yalilss< 

SNYI=X sSeHoIs 
SINYIYYA JI 187 


Fig. C-47 LAT ACCELERATION SLGMAS 


49 


00°32 oD°s6t 


3NE1d (A°X) 
y3l0l4 378ne0 


NOJieY3sI3sI9D9d 197 
SONDILYA 


oo"st 


oo"Eet 


NAY 


oo*ot 


VARIANCE CONVERGENCE 


Fig. C-48 


50 


3NE1d (A°X) 
¥31LN33 379N890 

INZISNOD AUN-OYd 
YOYYS NYY 


0S°0 


0O*1 
JONLINOYW YOYYS 


OS'T 


PRO-NAV CONSTANT OGUBLE FILTER 


Fig. C-49 


51 


PRO-NAVY CONSTANT 


E 


IGMAS: X=TRU 


PS) 


(X.Y) PLANE 


SRRAECS CR Se are Re A 
09°t 02"1 0e"0 
JONLINOVW 


PRO-NAV CONSTANT SIGNAS 


52 


O0v'O 


OGUBLE FILTER 


(35S) S3WIl 
S6'S OL's S2°% Ove SS°Z OL‘t se" 00°0 


a 


¥YOYUY3 Ne3sy 


bad ' 
a 
| Lome] 
atte | : 
ad Ww 
ro) 
| cain died ssf _ 
s |% 
| yO = 
ff > r=) 
i om So 
f a 
: 7a Zon 
| : : 
~~ 
ws 
ws 
cx 
a 
~~“ 
wy 
BNUTd (A'X) & 
Y3L114 378Ne0 R 
AYNS/SSBH - = 
| 


< 
lJ 
WwW 
ak ek ee 
& &€ we 2 
cee & 
—- t & wf 
MK A & 
> 
YW «- ~ 
yw > 
cc Cc . 
; oe ~ 
Oo ~ 
~ 
” 


Q 
+o 
5 
om 
uJ 
ip) 
uy Wd 
Ww) = 
an 
_ 


=] 
, oO 
Tae ERS ae ~ 
00°0° 


tatstghenetotiaatinsnigieliciatig deceit 
00°8 00°9 00'+ 09° 
L4/7145/S9N1S 


Fig. C-52 MASS/SURF SIGNAS OGUBLE FILTER 


54 


(238) sW1l 


€0°0 


SB°S OI'’s S2°% Ors SS°% : 
aes a. | 
E } 
w | 
' 
° tg 
7 3 3 
~ ww 
> ae 1 ™ m4 
©o¢>d pom 
. | va | 
SD fs 
Cc 
(Sp) Din 
w 
' oe 
a = 
° fe 
of aa 
ee ~ 
| = 


SNS1d (A°X) 
y3l113 378n00 
YaL3IueUsd Nel 

MOYYS NYS 


« 

. WwW 
ce We 
oe o> 6) 
— Cw = 
We & @& 
=— © H oJ 
GAA & 
ot 
Xow ~- 
ow ~ 
2 x 
ao ~ 
~~ 

” 


_ 9b'o 20'°0 80 "0 vO" 00 °0 
SONOIIAS 


Fig. C-54 TAU PARAMETER SICMAS OGUBLE FILTER 
56 


tc 
6 
tc 
a 
WwW 
rs 
a 
tJ 
x 


X-VELCOCITY 
OOUBLE FILTER 


(X.Y) PLANE 


00°OST 


Fig. C-55 


00°08 


00'°0 00 '08- 


Js3/ iiss 


X-VELOCITY 
57 


DOUBLE FILTER 


95 


5.10 


4.25 


2.85 3.40 
Fic tocc) 


1.70 


0.85 


Oo 
oO 
e 


00*09T-- 


FILTER 


X-VELOCITY 
>= 
(X.Y) PLANE 


SIGMAS: X=TRUE 


. 00°08 00°09 00 "0+ 00°02 
JdS/14334 


Fig. C-56 X-VELOCITY SICMAS OGUBLE FILTER 
58 


VARIANCE 
X-VELOCITY 


DOUBLE FILTER 
(X.Y) PLANE 


ih: aC Sie aCe ioe areRET TE. jog 
00'OZE 00'OrS 00'0St - 00°08 
,OTX  JINYUTYBA 


Fig. 0-57 VARIANCE CONVERGENCE 
59 


(93S) SWI4 
Ore ss°Z 


"0 


80 


¥0°O- 


SNU1088 
DOUBLE FILTER 


09'°0 


60 


ANG! E MEASUREMENT 


INS1d (AY) 
Y3LT14 31ND 
ANSABUNSBIA JTONS 


YOY NSH 


Fig. .C-58 


TRUE 


(4,7) PLANE 


= 
= 
WW 
fs 
a 
tc 
pan | 
2) 
aC 
ld 
& 
at 

j 
G 
= 
c 


SIGNSS: X 


9t'O 80'O 
, OX SNUI GUN 


Fig. C-59 ANGLE MEASUREMENT SICNAS OOURLE FILTER 


Sai 


61 


RANGE 
OCUBLE FILTER 
(X.Y) PLANE 


MEAN ERROR 


oO 
’ oO 
00'0 00°0Or- 00'O08- OO0'OZI- O0'OST- 
‘OUX 1334 


Fig. C-60 RANGE OCUBLE FILTER 
62 


oc 
J 
lu 
eo oe Red 
ear 
be tt 
WW Le | a 
oO x*« ao 
= 
CE xs = 
“- > 
a . 
p33 x 
o ~ 
— 
i") 


OO'OZE O0'OrZ 00°09 
. Lass 


00°08 


Fig. C-61 RANGE S{GMAS OOQUBLE FILTER 
63 


DOUBLE FILTER 
(X.Y) PLANE 


> 3 S 
00°0+ 00'0  O00'OV- 00'08- o0*DeT- 
, ,O1™ 9348/1334 


Fig. C-62 RANGE RATE OOUBLE FILTER 


64 


E 
FILTER 


TRU 
> 
(X.Y) PLAN 


a 
raven! 


Rp 
SIGMAS: X 


‘Tl Dr Ca sae 
O0*0F QO0"0E 00°02 09*Ot 


: ,Ol* Jdof Lass 


Fig. C-63 RANGE RATE SICMAS OGUBLE FILTER 


65 


3NB1d (A‘X) 
¥31TI4 37ENne0 
NOTLEY3SI3ZI38 197 
YoOvYs NYSH 


DOUBLE FILTER 


LAT ACCELERATION 


Fig. C-64 


66 


DGUBLE FILTER 


67 


LAT ACCELERATION STCNAS 


SNUTd (A°X) 
YBLII s=< 

SNy¥l=X =SBHIIS 
SINUILBA 330 1B7 


Fig. C-65 


NAY 
p0°Or 


OO°STI oo°et 


CONVERGENCE 


00'8 
JINUIYYA 


VARIANCE 
68 


SNY1d (A°X) 
y3itis 318nse 
NOJLIEY3713939 187 
SIND TUBA 


iad 
WJ 
‘co 
— 
“ 
iw 
uJ 
“ae 
ive) 
= 
oO 
Q 


(X.Y) PLANE 


Fig. %-67 


00°0 


00°r- 


00°6- 00°¢1- 


L43/714/S9N1S 


MASS/ SURF 


69 


DOUBLE FILTER 


Oo 
oO 


-00°9T-- 


«< 
WJ 
Wj bk 
= a! bb) 
i Gm 2 
eek a 
| Sa: ee 
MY x«x A & 
‘N\ 
DY a _ 
nn ~ 
eS & . 
x * ~ 
o ~ 
~ 
0 


00'°9 00'+ 
L43/14/S9N18S 


00° 


Fig. C-68 MASS/SURF SICMAS OGUBLE FILTER 


70 


(33S: 3WIl 
S6°S DL'S Sz 9 O~ € ss ‘Zz OL*t se 3 00° 


o6°t— 


1 
or 
3) 
>.) 
oO 
» 

raw} 
ae 
LoD 
q 
- 
— 
— | 
re 
sO 
On 


IND 1d tA‘X, 
¥3L113 37SNe 

ANSISNOD ABN-OUd 
2OUYS NUS 


PRG NAVY CONSTANT GOUJBLE FILTER 


Fig. C-69 


71 


ae (J3Ss 341_ 


S6'S JL's G7 °7 Ov € ss Zz GE Tt S32 J0°O, 
ro) 
OQ 
- 
>~ 
oO 

ee 
ow 
on 
of 
4 
a. 
| 
eS 
as 
Oo 
= 
rant 


SN81d (A‘X 
+9. i da< 
SNYI=EX ISBNSIS 
INSISNOD ABN-OUd 


SICM95 OCJUBLE FILTER 


PRG NAVY CONSTANT 


Fig. C-70 


1% 


(OSS) SWIl 
S6°S OL‘s S29 Ore ss °Z OL" 


et 
Ww 
co 
oO 


00°O 


é1°0 


1 
[ead 
ae | 
5 - 
Ww 
isp) uJ 
oe 
1 ™ = 
ow TT ae) at | 
- Oo oO 
<a ei 
. on 
— 
en 
“ad ~ 
o 2 
oO 
c 
@ oa 
Lea 
a. 
| 
c 
jus 
had 
SNUTd (A'X) J 
v3il14 37enca e 
yRLsueuYY NYL a 
| & 


YOY NSH 


SNS1d (A°X) 
Y3SLIIs=< 


SNYL=X 2SYHOIS 
Yalskeyed NY 


(J33 } 
Ov'e 


SWI 
ss °Z 


2t'0 80'0 
SONOIJS 


et 


DGUBLE FILTER 


TER SICMAS 


im 


TAU PARAM 


« C72 


Fig 


74 


Appendix D 


Appendix D contains the computer software used to evaluate the 
11 state filter. The only subroutine that is not contained in this 
appendix is Subroutine MINV - a matrix inversion subroutine. The 
software is organized as follows: 


Unit Page 


EPO rAM MU pEU se ora) cigiere.owierevelelarniele e's wie ele le sle(nintersie, eielere(einiscelecs alae fic 
(Executive program) 

Subroutine Traj.scacsesccsccsccsccsscccccscccccescsassccene OF 
(Truth models) 

Subroutine NOise ,.srcecccccccccccccccccsseressrsecesseseses OF 
(Generates noise values) 

Subroutine TIN cececccevccccvveresecsssceseesvescessseeeese GQ 
(Rotates vector as per Appendix A) 

Subroutine Cross sevescccereccccsesvcvccveccssecsscccsesveves 100) 
(Crosses two vectors) 

Subroutine DxCovar .scscccccsevcsccccccenccosceseccsssscves {i 
(Propagates the filter) 

Subroutine PMat ,cssccsvcccccccccccesecsvcscvevcvsssesscces 1()3 
(Evaluates filter's partial derivative equations) 

Subroutine DxGain sevecscccccccvcccceccvscsvessccsecveseses 15 


(Computes Kalman filter gain) 


Gibbootine UxPPIt ss. scdasenwaicawewneneaaanesnecnasenana S00 
(Computes the covariance update ) 

Subroutine DxSPluSecsecccccccccccccccecssosscesscscssesese 107 
(Computes the state update) 

Srhowr tine Reed coo encacascsencesepewdenteadiaenewense eas 06 209 
(Reads filter initialization values) 

Subroutine MMPY ciccstccdusassaeedceueustcaseceseaceossaee 209 
(Multiplies two matrices) 

Siivondine MRAR sc xcwescs bacaeeewa phan edeeness Coda shtoewss HOO 
(Transposes a matrix) 

Subroutine MBUB ssesicesstsuessxtaeedecswevcteccesarensenss Lil 
(Subtracts two matrices) 

Subsoutine MADD cs sscveccesssennswaxeccecvesseesevasseacess de 


(Adds two matrices) 
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Appendix E 


This appendix contains the graphical results of the Monte Carlo 
analyses of the 11 State Filter. For each K Set trajectory, the filter 
states are initialized to the initial true values. The tuning 


parameters used in the filter for all K Set trajectories are (Note: 


The state vector is [0,, 02, Wy, Wo; Rem? Rem? Aly Alo» Nps Tp 
(m/s) o]"): 
3.E-5 0 0 0) 0 0 
0 3.E-5 f) 0) ) ) 
) 0 3.E-5 0 0 ty) 
™ i» ) ) 3.E-5 0) () 
0 fy) ) 0) 5.E-4 ) 
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